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ABSTRACT 



Adaptive compliance control of a single robotic joint was studied to control the 
amount of torque applied on an object by an end effector, which is actuated by an 
electric motor through a gearbox. 

For this reason, an adaptive control system was designed. Variation in stiffness and 
compliance was observed by simulating the system with A//1 77?/A’,package program. 
After observing theoretical variation of the stiffness and the compliance, experiments 
were done to observe and prove the stiffness control theory. 

The proved theory was then applied to a robotic finger joint actuated by a small 
DC motor. 
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I. INTRODUCTION 



One of the most important problems in robotics is the design of a dextrous end 
effector. A dextrous end effector is a kind of gripper or a tool that enables a robot to 
hold or handle different kinds of objects easily and skillfully, like a human being. Dif- 
ferent techniques can be used to give that kind of ability to the end effector. Two of 
those techniques are direct drive and indirect drive. In indirect drive, the fingers of the 
dextrous end effector will be driven by tendon cords which are actuated by electric mo- 
tors installed into the arm. In direct drive, the fingers are actuated by electric motors 
installed directly into the finger itself. Unfortunately, many actuators are best suited to 
relatively high speed and low torque, therefore they require a speed reduction system 
which is usually a gearbox. 

In today's automated machinery, reliability is an important factor. Since reliability 
decreases with increasing complexity, it is better to try to keep the end effector simple 
in both its design and function. The main source of complexity in dextrous hand design 
comes from the finger joints. In figure 1, tendon cord controlled dextrous end effector 
is shown. As can be seen from the figure, pulleys and the tendon cords used to actuate 
the fingers presents a considerable amount of complexity. 

In a tendon cord design, the designer must consider the tension of each tendon, since 
any slack will cause a problem. After gripping an object, the power on the tendon cords 
must be kept to maintain a grasp on the object. Another problem will be the weight of 
the hand. Since the weight of the hand and the arm is increased by a tendon cord and 
pulley system, this will cause problem in arm joint (elbow) and shoulder joint designs. 

By using a direct drive method in the finger joints, the difficulties listed above can 
be overcome to some extent. By installing DC servo motors directly to the finger joints 




Figure I. Tendon Cord Controlled End Effector. 



as shown in Figure 2, the linger links can be moved without tendons. The weight and 
keeping the power on alter the gi ip will not be a problem. If the motor drives the joint 
through a high ratio gearbox, power may be removed from the motor, and the small 
amount of armature friction will prevent the motor from being backdriven. T his means 
that a grasp is maintained with power removed. Since the complexity of the joint will 
be less, the reliability of the system will be higher. I3v using a gearbox to transmit the 
motor torque and installing the actuators directly into the finger, this system provides 
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torque multiplication and increased position resolution which are very critical properties 
in the successful design of robot joints. 

Although having a joint nonbackdriveable is an advantage, there are disadvantages, 
for example in handling delicate objects where a relatively large compliance in the finger 
joint is desirable. 

In a finger joint a direct drive element must therefore carry out two tasks. 1. It 
should be able to bring the joint to the desired position, and 2. after contact with an 
object it must provide enough grip to hold or to manipulate the object without breaking 
it. 

Therefore our system must have two characteristics. It must provide position control 
and necessary torque without breaking the object. While position control is enough to 
provide a desired trajectory, when contact is made between the end effector and the ob- 
ject. position control may not be sufficient. 

Contact force applied on an object will be the major problem with the direct drive 
end effector. The contact force applied by a direct drive end effector on an object will 
be decided by the stillness of the servomechanism used to actuate the joint. Usually 
servomechanisms have high natural stillness due to the high gear ratio. This may cause 
some problems when manipulating fragile objects. This problem may be overcome by 
changing the stiffness of the system for certain tasks. Stiffness of the servo system will 
be defined as 



Where r d = the disturbance torque applied to the output shaft and 0 C = the angular 
displacement of the output shaft. By changing the stiffness of the system, torque applied 
on the object can be controlled. The inverse of stiffness, namely 



3 




Figure 2 . Direct Drive End Effector 



0 



o 






( 1 . 2 ) 



will be defined as compliance of the system, 

The purpose of this research is to design a simple system that will provide both po- 
sition control and torque control, and by changing the stiffness of the servo system to 
be able to control the applied torque on the grasped object. 
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The thesis consists of eight chapters. Following the introduction, chapter 2 presents 
the theory of stiffness and compliance control. The third chapter is devoted to system 
parameter identification of the experimental system. Simulation results of system re- 
sponse are presented in chapter four. The fifth chapter is devoted to experimental 
stillness control of the system while chapter six discusses the adaptation of stiffness 
control to a prototype finger configuration. Following the discussion chapter, conclu- 
sions are presented. 
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II. THEORY OF STIFFNESS AND COMPLIANCE CONTROL 



Interaction between objects and the end effector presents a much more complicated 
problem than position control. When an end effector is moving in a free space, there 
isn't any constraint, namely it does not touch any object that's going to constrain its 
motion. When it has contact with an object, a new variable defined as a disturbance 
must be added to the system. 

A. POSITION CONTROL SYSTEM AND STIFFNESS OF A SYSTEM 
1. Standard Position Control system: 

The object in a position control system is to control the angular position of the 
output shaft. The desired position of the output shaft is achieved by a voltage that has 
been generated by means of a potentiometer, as shown in the block diagram in 
Figure 3. The angular position ((?,) of the potentiometer generates a proportional bipolar 
voltage according to the potentiometer's transfer function ( k po , , volts 'radian). This 
voltage is compared to the achieved position of the load or output shaft of the motor 
as measured by another identical potentiometer. An error voltage is generated by sum- 
ming these two voltages. Usually after passing through an amplifier, this voltage drives 
the motor. This amplifier's gain is usually called the forward path gain of the system 
(/<„). The angular velocity of the motor shaft is obtained after the applied voltage is 
passed through the motor. Following the motor, there is usually a gear box. Dividing 
motor shaft's angular velocity by the gear ratio, the angular velocity of the motor's 
output shaft velocity is obtained. Since dilferentiation of the position gives the velocity, 
by integrating the angular velocity, angular displacement of the output shaft can be ob- 
tained. This angular displacement of the output shaft is fed back to the system to achieve 
desired position. 
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Figure 3. Standard Position Control System. 



In the block diagram following constants are used. 



K s = Motor constant (rad sec volt) 
k po ,= Potentiometer constant (volt rad) 

T m — Mechanical time constant (sec) 
k„ = Forward path gain 
N = Gear ratio 

In position control systems, different kinds of electrical motors can be used, 



although a DC motor has been used in this research. The DC motor is a power actuator 
device that delivers energy to a load. DC motors rotate due to the interaction of two 
magnetic fields, one in the stator, one in the rotor. The rotational speed may be varied 
by controlling the strength of one of these fields. The input voltage can be applied to 
either the field or the armature terminals. The air-gap flux of the field current is pro- 
portional to the field current. So that 



K f — Field constant 
i t — Field current 

The torque developed by the motor is assumed to be related linearly to </> and 
the armature current as follows 




( 2 . 1 ) 



T m = K x 4>i a {t) = K x Kjij(t)i a {i) 



( 2 . 2 ) 



x m = Motor torque 



i„ = Armature current 
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In order to have a linear element one current must be maintained constant 



while the other current becomes the input current. Two kinds of motor can be defined 
based on this principle, field controlled motor and armature controlled dc motor, as 
shown in Figure 4. By taking Laplace, transform of equation (2.2) the following 
equation is obtained. 



T m (s) = (K ] K / I a )! J (s) = K 7 I J (s) (2.3) 

Where K T — Motor constant (Nm amp) 

The field current is related to the field voltage as 

V/s) = (R f + L^I/s). (2.4) 



V f = Field voltage 
L f = Field inductance 

The motor torque is equal to the torque delivered to the load. This relation may 
be expressed as 



TJs) = T l (s) + T Js), 



(2.5) 



T L = Load torque. 

T d = Disturbance torque. 

The load torque for rotating the inertia shown in Figure 4 is written as 

T L (s) = Js 2 0(s) +fsd(s). (2.6) 
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Figure 4. A DC Motor a) Wiring Diagram b) Sketch. 



Rcai ranging equations (2.3), (2.4) and (2.5), the following equations may be 
obtained, 



T / ,(.0 = T„ 1 (s)-T i ,(s). 
T m (-s) = K r Ij(s), 



(2.7) 

( 2 . 8 ) 



W) - ~r> 






R f + L f s 



(2.9) 



'I hcrcforc, the transfer function of the motor-load combination will be as fol- 



lows 



JO 



O(s) 

>yW 



( 2 . 10 ) 



A r 

JL f 

f R f 

s(i + — )(.S + — ) 

The block diagram of the field controlled dc motor is shown in Figure 5. 
Alternatively, the transfer function may be written in terms of the time con- 
stants of the motor as 



-h-L 

Oh) fR f 

l / s ) S ( T / S + 1](TF +1) 



Lr / 

where t / = — and r L = -=- r 

R/ J 



Since usually x L > T /- the field time constant may be neglected. 

The armature controlled dc motor utilizes a constant field current, therefore the 
motor torque may be written as by 



T m (s) = (K ] K / I / )I a (s) = K r I a (s). 



( 2 . 12 ) 



The armature current is related to the input voltage applied to the armature 
by 



V a (s) = (R a + L a s)I a (s) + b t (s), 



(2.13) 



where f'j(s) is the back electromotive-force voltage proportional to the motor speed. 






(2.14) 



hence 
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Figure 5. Block Diagram of Field Controlled DC Motor. 






{R a + L a s) 



(2.15) 



The same load torque equations, (2.6), (2.7) will be valid for armature control 
also. The relations for the armature controlled dc motor are shown in the Figure 6. 
The transfer function of armature controlled dc motor will be as follows 



Q(s) Kr 

1 ~ st{R a + L a s)(Js+J) + K b K T l ' 



(2.16) 



For many dc motors, the time constant of the armature, t„ = ~jr~, is negligible. 
The resultant transfer function will be as follows 



where the time constant r, 



[ ] 

e(s) _ (R/+ a-„a- 7 ) 

i(T|.S+l) 

RJ 

(R/+ a;a;„) • 



(2.17) 
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Disturbance 







Position 

(9(5) 



Figure 6. Block Diagram of Armature Controlled DC Motor. 



2. Effect of load inertia: 

A study of the free body diagram of the motor, gearbox and the load will be 
helpful to write the equation motion of the mechanical part of the dc motor in 
Figure 7. 

Since the armature inertia and the viscose friction have to be overcome, all of 
the torque generated (r m ) is not available at the gearbox input shaft. The general 
equation of motion of a torque generating system may be written as 



Ys > =jd - < 2 - 18 ) 

i=] 

Considering the gearbox ratio N> 1 the equation of the motion can be written as follows 
For the motor shaft 
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J, 




Figure 7. Free Body Diagram of DC Motor. 



T m — T, — C] j — J a (o i 



(2.19a) 



For the load shaft 



t 2 — C L (0 2 ~ 



(2.196) 



For the gearbox 
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r 2 = At, 



(2.19c) 



w 2 = 



c^I 

.V 



r m = Motor torque 
J 0 — Armature inertia 
J L = Load inertia 

C0[ = Motor shaft angular acceleration 

cu, = Motor shaft angular velocity 

a > 2 = Output shaft angular acceleration 

a> 2 = Output shaft angular velocity 

c, = Motor shaft damping 

c L = Output shaft damping 

Referring all variables to the motor shaft gives: 



\* a t! * 1 



J l (.0 2 



C-.CO 



i. z : ,u 2 , . 

x m y y 



1 



c 2 ro, 



T m , , 2 ^ 1*^1 y ^< 3 ^] 



A 



Resulting in the final equation 



(2.20) 

( 2 . 21 ) 

( 2 . 22 ) 



./, . c 2 

T /?i = (^a + — T )^1 + ( C 1 d ~)&>l (2.23) 

. \ i > 

In the equation of motion there is an important property that has to be noticed. 
The effect of the gearbox reduces the load inertia and load shaft damping factor by A' 2 . 
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This means that, by using a gearbox we may apply less torque to the motor shaft to 
accelerate the load on the output shaft. Another interesting effect of the equation can 
be seen, when the torque is applied to the output shaft to turn input shaft. Then fol- 
lowing equation will apply: 

^ = (J a X 2 + Ji)a> i + (cpV 2 + ejeo, (2.24) 

In this equation, the effect of input shaft's inertia will increase by N 2 . As a result of this 
effect, it will be easier to turn the system in the figure by applying torque on input shaft 
rather than on output shaft. This is one of the important properties used in control 
systems design to reject disturbances. 

3. Analysis of the servo system: 

Torque generated by the armature is linearly related to the current applied. 
Torque generated by the armature is given by 

= K r I a . (2.25) 

Here K T is the motor torque constant with units Nm amp. This generated torque ac- 
celerates the motor armature itself and an external load. It also overcomes viscous 
damping torque and any external load torque. 

As demonstrated, in the preceding section of the chapter, the load inertia rather 
than motor inertia may be neglected, if N > > 1. The transfer function from motor 
torque x„ to output angular velocity co, is obtained by taking the Laplace transform of 
equation (2.24) and re-arranging in the form. 



co 1 

T Js + c 



(2.26) 
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Where J is the total inertia referred to the motor shaft and c is the total damping referred 
to the motor shaft. Both the mechanical and electrical part of the motor gearbox com- 
bination can be seen in Figure 8. The complete position control system block diagram, 
is now shown in Figure 9. 

The close loop transfer function of the system becomes 

~e ~ = \s(Js + c) ~/?7 * “ kb ° ),n + k ^° ik p° i ~°o k poi))~\ ( 2 - 27 ) 

Using u),„ = A 's6 0 , the transfer function of the system can be written as: 



./A + (cA + ^ /q, A R)s + A 



where A = k a — ~ 

4. Disturbance effect on the position control system: 

The main variable in stiffness and compliance control of a servo mechanism is 
the torque applied on the object. This torque must be adjusted according to the dis- 
turbance torque sensed from the object. When an end effector applies a torque on the 
object, the object will apply a reaction torque on the end effector. I his will cause a dis- 
turbance effect on the system. In Figure 10 a sketch of an end effector applying torque 
on an object and the object's reaction torque are shown. This disturbance torque will 
have a braking effect on the output shaft. The analysis of the system may proceed in the 
same manner identical to before, except that the equation of the load shaft will be 
modified due to the disturbing torque x d . 

Considering the disturbance torque and gear box effects as shown in 
Figure 1 1, the equation of motion of the system may be written as follows 



17 




5 ><- 



JO. 



/=! 



( 2 . 29 ) 



x d 



J, 



J7 ~ {Ja + ~T )^m + ( C 1 + ~~T 

1 ' A A 



( 2 . 30 ) 



An equation may be written considering total inertia and damping of the sys- 



tem. 



2 ± 

N 



- + c U) m 



( 2 . 31 ) 



t h = Disturbance torque 

o) m = Motor shaft's angular acceleration 
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Figure 9. Position Control System. 

u) m = Motor shaft's angular velocity 



19 




Figure 10. Free Body Diagram of a Torque Applying End Effector. 

'Flic equation of motion of the system may written as 

0o = AX7 * + C) c -T, + { - k b 0 , m + A a ((?,./ W -0 o k pol )} ] (2.32) 

and represented in block diagram form as shown in Figure 12. 

The transfer function of the system including a disturbance torque and keeping 
constant can be written as follows 




XJs 2 + ( cN + 



1 

Ar ^ 7 ^POl 

■fk b N)s + k a —jf- 



(2.33) 



Again using oj m = Ns0„, the steady state response of the system to a disturbance 
torque is: 
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Figure 1 1. Free Body Diagram of Motor Shaft With Gear Box and Disturbance. 



T J 



R 



Lk 



a'^pot^T 



(2.34) 



An indication of the system stiffness can be seen when one tries to turn the 
output shaft of the system by hand. The system will show a resistance to the hand, 
opposite to the desired rotation. The resistance is caused by the voltage generated by 
the output shaft's potentiometer. As stated above, this voltage will be fed back to the 
system as a negative signal, meaning that, the motor will generate a torque opposite to 
the torque applied to the output shaft by the hand. The ratio of rotation to torque, 
given in equation (2.35) is the stiffness of the servo. 
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Figure 12. Position control system with disturbance. 
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^a^poi^ T 



(2.35) 



*</ 




There arc lour values which may help to change the system's stiffness. '1 hese 
can be seen in equation (2.35). In this equation only A„can be changed. As k a increases 
stiffness of the system will be increasing. K T & R can not normally be changed, because 
they are particular values which are fixed by the motor. Changing the value of k a can 
be considered, but it is not going to be a very good option, since this gain easily may 
make the system unstable. Tor this reason, another way of changing the stiffness must 
be considered. 

B. COMPLIANCE CONTROL STRATEGY 

1. Description of how stiffness may he changed: 

Suppose that 1 Nm. disturbance is applied to a servo system and 1 rad. rotation 
of the output shaft is observed. This means that the stiffness of the system is 1 Nm rad. 
If a higher rotation is desired by applying the same torque, the stiffness of the system 
will be lower. Namely, instead of 1 rad. of rotation, for example, 5 rad. of rotation is 
observed. Therefore, the stiffness of the system will be 0.2 Nm rad. 

To be able to control the amount of torque applied on the object after contact, 
rotation of the output shaft must be controlled. 

Since the voltage applied to the motor causes the rotation of the output shaft, 
by increasing the amount of voltage going to the summing junction before the motor, 
rotation of the output shaft can be increased. This will cause additional rotation of the 
output shaft for the same torque. Therefore the stiffness will be decreased. The new 
block diagram of a system which has variable stiffness ability is presented in figure 13. 
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Figure 13. Position Control System With Disturbance Feedback. 
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The measured disturbance torque is fed back to the summing junction before the 
motor. By passing the measured torque through a variable gain E, we will be able to 



control the amount of additional rotation of output shaft. 

The new equation of motion of the system will be as follows 




{ —k b (o m + k a {Q t k pot ~0 o k pol - r d E)}~] (2.36) 



Keeping (?, constant, the following transfer function of the system can be ob- 
tained. 



where E is in volts: Nm. 

2. Stiffness as a function of gain E. 

To demonstrate the variable stillness and compliance in a servo system . E and 
r d are assumed to be positive in equations (2.36), (2.37), (2.38). Thus the following 
equations were obtained as a transfer function of the system. 




A fk pot 



R 



(2.37) 



Steady state output of the system, assuming k c = 1 will be 




(2.38) 
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(2.39) 
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(2.40) 



This is defined as the compliance of the system. The stillness is the inverse of compliance 
as shown in the following equation. 



As can be seen in equations above, the only variable is E. Therefore by changing E, the 
stiffness of the system may be changed. 



were plotted, as shown in Figure 14 and Figure 15. The compliance of the system will 
be directly proportional to E. Since the stiffness of the system is the inverse of the 
compliance, the stiffness of the system will be inversely proportional to E. At the same 
time rotation of the output shaft will be directly proportional to E. The potentiometer 
constant will determine the slope of the curve. As k po , increases, the slope of the com- 
pliance curve will be decreasing. When E is zero, the stiffness of the system will be 
equal to it's natural stiffness or original stiffness. 

C. EFFECT OF EFFICIENCY OF A GEAR TRAIN: 

Another problem which has to be discussed, concerns the disturbance torque. Ac- 
cording to the gear theory, as presented in equation (2.19c), the disturbance applied to 
output shaft has to be divided by the gear ratio N to refer it to the motor shaft. 

Efficiency of the gear train is another important effect which has to be addressed. 
It is defined as the ratio of the output power to the input power, or the ratio of the work 




K- 



(2.41) 
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output to the work input over the same period of time. For an ideal mechanism, it will 
be 100 % or 1. In reality, a normal gear train will dissipate some of the power which has 
to be transmitted. Ffliciency can be written as: 
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power out 
power in 



( 2 . 42 ) 



In the case of the gear train, it has to be restated, because there is a gear train ratio. 
The new equation will be as following 
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(2.43) 



actual output torque \ 

> 1 = : -T7 

input torque A 

The efficiency of transmission can be determined by measuring the resulting torque 
on the output for static torques applied to the input shaft. 

The efficiency of any mechanical device will become significant with robot end 
effectors actuated by motors driving through high ratio gearboxes. It is no longer safe 
to assume that the output loads are reflected to the input shaft by a function of the gear 
ratio, since any efficiency less than 1 will increase the torque required to accelerate a 
given inertial load or overcome an external torque. It is also important to notice that the 
efficiency of the gear train does not affect the actual transfer ratio of the gears in terms 
of displacement, velocity or acceleration, but greatly affects any torque related property. 
Efficiency is dependent on such factors as the coupling ratio, the material's coefficients 
of friction, and the angle used to define the gear teeth or the depth of cut and type of 
threads for screws. 

Another interesting effect of efficiency is on the gear train's backdrivablity. 
Backdrivablity is the ability of a gear train to transmit the torque or the disturbance 
that has been applied on the output shaft side of the gear system, to the motor or to the 
torque source as shown in Figure 16. 

In general as the efficiency goes higher, the backdrivablity will be higher, i.e the 
system is more likely to be backdrivable. At the same time a gear trains efficiency may 
be different for each side. For example in the case of worm gears, it will be zero for 
transmission of the torque from the load to the motor. Sometimes this property is good 
in robotics application, because it will help rejection of the disturbance torque, which 
may be a gravitational or frictional torque. 
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Figure 16. Transition of the Disturbance Torque to the Motor. 

At the same time, nonbackdrivablity will influence system stiffness, because the 
transfer function of the system will change. 

The new equation of motion of the system will be as follows 

0° = + L ,J c { -kb^m + k a {0,k pol —0 o k pol + x d E )} ] (2.44) 

Keeping 0, constant, the following transfer function of the system can be obtained. 



T d 



NJs 2 + (cN + 



(E) 

A. j' 

i r 
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k b N)s + k a 



kjk pot 
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Steady state output of the system, assuming k„ = 1 will be 

_ E 

X<1 kp OI 



The stillness of the system will be 



(2.45) 



(2.46) 
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(2.47) 




II' positive feedback is used, the system stiffness will be positive infinite when IS goes to 
zero. As F is increased, the stiffness of the system will decrease as shown in figure 17 
and Figure IS. 

The effects mentioned above must be considered in our model in order to obtain 
high accuracy. Therefore as one can see from Figure 19, two new variables are added 
to the system. These are: 

K = Nonbackdriveability constant 
>/ = Efficiency of the gear train 

Where, K = 0 (nonbackdriveable) 
or K = 1 (backdrivcable) 

for backdcrivcable systems. Again keeping 0, constant, the new transfer function, 
compliance and stiffness of the system will be as follows 




(2.4S) 




(2.49) 
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(2.50) 
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STIFFNESS (NM/RAD) 



STIFFNESS (NONBACKDRIVADLE) 




Figure 17. Stiffness Variation of a Servo System (uonbackdriveable). 



I he important conclusion drawn from the above discussion is that the system may 
have a finite stillness by using disturbance feedback through h even though the original 
system was not backdrivcablc, corresponding to infinite stiffness. 
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Figure 18. 



Compliance Variation of a Seno System (nonliackdi iu-alile). 




figure 19. Position Control System Including Efficiency and Backdrivability. 



III. SYSTEM PARAMETER IDENTIFICATION 



Electric motors used with end effectors or robotic finger joints, are usually small 
motors, hence, it is difficult to observe the variation in the compliance and the stiffness 
of these kind of systems. It is also difficult to measure certain parameters exper- 
imentally, therefore, a larger servo system was used to observe and to prove compliance 
theory. 

A feedback ES151 educational servo system, together with suitable test equipment 
was used to prove compliance and stiffness theory. This is a high quality electro- 
mechanical servomechanism, consisting of three basic units: actuator unit, educational 
servo unit and accessories and spare parts as shown in figure 20. 

The actuator unit is essentially a 24 v electric motor unit, a tachogenerator, gear 
box, output disc and a potentiometer. 

The educational servo unit is the control unit of the system. It contains all the nec- 
essary power supplies for the system to operate. The main parts of this unit are com- 
mand input, control circuits, preamplifier, servo amplifier, schematic of the actuator 
unit, current meter and on off switch as shown in Figure 21. 

The ES151 educational system is built for standard position control. The block di- 
agram of the general system as a standard position control system is shown in 
Figure 22. As can be seen from the block diagram after, applying a voltage to the mo- 
tor, an angular velocity of the motor shaft is obtained. Dividing motor shaft's angular 
velocity by the gear ratio, the output shaft angular velocity is obtained. Integration of 
this angular velocity gives position of the output shaft. Voltage obtained by using an- 
other potentiometer attached to the output shaft, fed back to the system as a negative 
signal. T he sum of two voltages gives an error voltage which drives the motor. Finally 
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Figure 20. Feedback ES 151 Educational Servo System. 
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Figure 21. Educational Servo Unit. 



the output shaft angular displacement will be the same as input displacement introduced 
to the system by using conunand input. 

In the block diagram the following constants arc used. 

K,= Motor constant (rad/scc/volt) 

A r<) ,= Potentiometer constant (volt/rad) 
k b = Back cmf constant (volt/rad, see) 

T m = Mechanical time constant (sec) 



37 




Figure 22. Block Diagram of Educational System As a Standard Position Control 
system. 
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k a = Control amplifier constant (forward path gain, servo amplifier gain) 
k p = Power amplifier constant 

The main difference between this diagram and the standard position control system 
diagram, which was presented in chapter 2. is k t . This constant gain is added to the 
system to increase the voltage going to the motor. It amplifies the potentiometer's out- 
put voltage and matching it to the DC motor. The procedure for finding these constants 
experimentally is a standard laboratory exercise (ME 3802) and presented in appendix 
A. Estimated values of these parameters are as follows 
K s = 270 rad sec/volt ( when k„ = 0.7) 
k v = k b = 0.0022 volts rpm 
k p „, = 5.7 volts rad. 

T m = 0.25 sec. (open loop time constant) 
and 0 < k„< 1 . 

As stated at the beginning of the chapter, the main reason for using this system is 
to experimentally prove the compliance and stiffness theory previously discussed. The 
block diagram for the ES151 system is somewhat different from that used in the devel- 
opment of the theory of variable compliance - see Figure 22 and Figure 23. For this 
reason, conversion of the identified parameters to those necessary to determine the 
stiffness are necessary. The following equations indicate the equivalence of the parame- 
ters. As can be seen from the figures, a new variable k p is added to the both systems, 
in order to match educational systems block diagram with position control systems 
block diagram. 



A 'j' 

~Rc 



a; 

1 + T m s 



(3.1) 



Therefore, 




Figure 23. Block Diagram of Position Control System. 
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(3.2) 



K t = Motor torque constant (Nm Amp) 

R = Resistance (ohm) 

J = Total inertia (Nm sec* *2; rad) 
c = Total damping (Nm sec rad) 

In equation (3. 1) and (3.2), the value of T m and A' are known. Therefore, the value 
of c can be found after finding the value of J. The value of J may be found by performing 
a torsional pendulum experiment. 

1. Torsional pendulum experiment: 



gidity and a stop watch. The armature of the motor is taken out and attached to the wire 
by way of the collet. Then the wire is attached to a fixed support where armature's free 
movement can be obsened, as shown in Figure 24. A half twist is given to the armature 
and allowed to oscillate freely. The equation of motion of the system will be as follows 



This experiment requires a collet, a piece of wire with known modulus of ri- 



je + ko = o 



(3.3) 



J = Moment of inertia of the armature. 



K = Torsional stiffness of the wire. 



The angular frequency of the system will be as follows 




(3.4) 



(o = Angular frequency of the system. 
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Then, J = -^r. 

co 2 

To find the angular frequency of the system, time was recorded for ten oscil- 
lation of the armature. Dividing the time by number of oscillation gave the period of the 
motion in sec cycle. Then, it was converted into angular frequency in rad sec. The 
stillness of the wire was calculated by using following formulas. 



T _ 07 
Q l 



(3.5) 



Where / = 



GtuP 

32/ 



G = Modulus of rigidity. 

1 = Length of the wire, 
d = Diameter of the wire. 

T = Torque. 

The measured dimensions and properties of the wire were: 
d = 2.54E-4 m 1= 0.61595 m 
G = 40 Gpa. 

The following results were obtained: 

co = 1.239 rad! sec & K= -jj- = 2.65E— 5NmJrad. 

So ,J = 1.726E — 5 Ams J c; 

rad 

Since, J is now known, the value of c can be calculated by using following 
equation. 



./ 1.726E— 5 ^ r, r- r A7« sec 

c “Tr -— a25 ME - 5 ~^d~ 



(3.5) 



K 

After finding the value of c, the only unknown will be This value may be 

found by performing a speed-torque experiment. 
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Figure 24. Torsional Pendulum. 



2. Speed-Torque Experiment: 

When a constant voltage is applied to the motor terminals, the motor shaft will 
accelerate and attain a final steady state velocity. This may be explained mathematically 
by using open loop block diagram of the position control system in Figure 25. 

The equation of motion of the system will be as follows 

” 7T+7 c T" + if <W' ( - («) 

Steady state response of the system into a step input as disturbance with con- 
stant If will be 
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Figure 25. Open Loop Speed Control System. 
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(3.7) 



Assuming — Pc 




(3.8) 



In equation (3.8) the value of T d < 0 and l'= a constant. This equation is 
an equation of a straight line, which may be written as 



C equals to ( V, — — ). The onlv variable in equation (3.8) is r d Since the value of ^<0, 

k b 

this curve will have a negative slope. When a constant f, applied to the terminals of the 
motor without a braking or disturbance torque. (o m without load will be obtained and is 



braking or disturbance torque applies enough torque to stop the motor, (-mX) will 
equal to C. This point will be Y = 0 & X = T d on the curve and is known as the stall 
torque of the motor. This curve is shown in figure 26. Since two points are known, the 

line can be drawn. To get necessary data, the following procedure may be carried out. 

1. Establish a constant voltage, f, 

2. Calculate the value of k p &k,. 

3. from no-load speed calculate A* 



T = — mX + C 



(3.9) 



Here, m is the slope of the curve and is equal to ( 




)• 



k.k. 



known as the no-load speed. This point will be X = 0 & Y = f , — — . When the 
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4. From slope calculate -jr 

Ilowever. the braking torque can not be applied directly to the output shaft in 
the educational system, because of the gear box has a worm gear in it. As discussed in 
chapter 2, this means that system is nonbackdriveable and the motor can not be stopped 
by applying the braking torque directly to the output shaft. That's why, the braking 
torque is applied to the motor shaft, so the value of A" becomes 1 and the speed torque 
test is performed on the motor shaft, rather than on the output shaft. 

After establishing a constant angular velocity, F, was measured and found to 
be 0.43 volts. 

Before applying the voltage to the dc motor there are two amplifiers. As stated 

above these are controller amplifier and power amplifier as shown in Figure 27. To find 

k„, V e and F, voltages are measured. The ratio of these two voltages, namely -rr gives 

V m t ' i 

k c . After measuring V m , the ratio of —rr will give k p . 



From the ratio of ( C , - J - ■). the value of k b may be calculated. Where, V m is the 
input voltage to the motor and w NL is angular velocity of the motor shaft under no-load 
conditions. 

Braking torque is applied to the motor shaft by attaching a torque lever arm to 
the motor shaft. A scale was put under this arm to measure the braking torque applied 
to the motor shaft. When the angular velocity of the motor shaft was zero, the scale 
showed 40 grams. The braking torque was found to be 



r d =l VL (3.10) 

Where, W = (40,T000)kg * (9.81 -^ r )= 0.3924 N (lifted weight) and L = 0.224 
m.(length of the arm). After multiplying W by L, the value of x d was found. Then, the 
value of x d and co AX were plotted on the speed/torque diagram. The results of the exper- 
iment may be summarized as follows 
Measured data: 

V, = 0.43 volts 
V c = 0.206 volts 
V m = 8.45 volts 
Derived data: 
k a = (0.206 0.43) =0.48 
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ANGULAR VZLOCITY(RPU) 




Figure 26. Speed-Torque Curve. 
k r = (8.45/0.206) = 4 1 

k b = (8.45/504 1 )volts/rpm= 1 .671i-3(volts/rpm) 
llcncc finally 

— 77 - = — = 0.01 Ninl volts 
l\ 

1 he expei imental speed, 'torque curve for the motor is shown in Figure 28. 
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Figure 27. Poncr and Control Amplifier Clock Diagram 

Now tli at all parameters in the block diagram in Figure 23 have been identified, 
the system may be simulated in order to observe its steady state and transient response. 
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Figure 28. Experimental Speed-Torque Curve. 
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IV. COMPUTER SIMULATIONS 



Before performing experiments on the model, variation of the stiffness and com- 
pliance were observed by simulating the system with the MATRIX x package program. 
Also, the system response to different kinds of inputs and the resulting transient re- 
sponse were observed. 

As stated in Chapter 111, the ES151 educational system has a worm gear in the 
gearbox, therefore the natural stillness of the system was infinite. This means that, ro- 
tating the output shaft by using a disturbance torque, without feedback from the dis- 
turbance torque, was impossible. But this does not mean that motor shaft also has 
infinite stillness. The following equations may give a better view of this situation. 



and therefore it is K m which will be simulated. 

A'„ = system output stiffness. 

K m = motor shaft stiffness. 

0 m = motor shaft angular displacement. 

0 o — output shaft angular displacement. 

Since, the disturbance torque is applied directly to the motor shaft, the gear ratio, 
the efficiency and backdcriveablity constant will all be unity. The system block diagram 




(4.1) 



since, 0„ = 0 



However, 




m 



(4.2) 
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with gear ratio equals to one, including the parameters found in Chapter III. without 
feedback from the disturbance torque is shown in Tigure 29. 

As can be seen from the block diagram, a step disturbance was applie directly to the 
motor shaft, and 0, is assumed to be constant. 

The system step response is shown in Figure 30 (<f < 1), Figure 31 (5 > 1). and is 
seen to be that of a second order system. 

Using the following formulas system characteristics may be found in terms of : 

P.O. = Percent overshoot 
T f = Peak time 
l — Damping ratio 
T s = Settling time. 






(-1.3) 



co 






P.O. = 100c' 



;l-r ’ 



( 4 . 4 ) 



/; = 



j f. 



to,. 



(4.5) 



The transfer function of the system including the disturbance torque. L and keeping 
0, constant can be written as follows 



77 



AVC + A' + -f- k b X)s + k a k p 



K r 



(4.6) 
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Figure 29. The Block Diagram of the Model With Unity Gear Ratio and Without 
Feedback From the Disturbance Torque. 
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COMPLIANCE or TIIE MOTOR SIIArT VS TIME 



Figure 30. Step Response of the Motor Shaft, t < 1 . 



Again using = lXsO , . the steady state response of the system to a disturbance 
torque is: 



v r> 



R 



^a^pkpot ^ T 



(4.7) 
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Figure 31. Step Response of the Motor Shaft, £ > 1 . 



So, the stiffness of the system will be 



Trf ^<i^pkp 0 i h t 

__ - 



( 4 . 8 ) 
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Equation (4.6) may be approximated into the form of a regular second order transfer 



function, i.c. 




(4.9) 



To be able to get an ideal transient response, the damping ratio of the system must 
be adjusted. Having a 1\0. close to 0 will provide the ideal transient response. For this 
reason, £ or co„ (natural frequency of the system) must be changed. The only variable 
in the system which can be effective in optimizing these values is k„. As can be seen in 
equation (4.6), this value also effects the stillness. To be able to obtain the optimum 
gain of k a for ideal transient response and observe it is effect on the stiffness, the system 
was simulated with different values of k a . It was observed that when 0.87 < k„ <0.91, the 
system had the ideal transient response as shown in Figure 31. The system response is 
presented in the form of compliance and as can be seen from the figure the steady state 
response of the system was as predicted in equation (4.7). But, it must be noticed that 
simulation gives us the compliance as measured at the output shaft, not the motor shaft, 
therefore, the result must be multiplied by the gear ratio which is 30 in this case. The 
inverse of this value gives the stiffness of the motor shaft. 



where, 0 m = d c i\. 

Before designing and putting together the necessary experimental system, the effect 
of the gain E on the system transient response must be determined, therefore, the torque 
feedback as presented in the theory section was added to the system. After adding this 
feedback, the system stiffness may be changed from infinity to a finite value. Since, the 



0 



- \R 



k.-i k ri k r ,n T h ■ 



(4.10) 



■a l 'p K poi I 'T 



system is nonbackdiriveable, K is equal to zero. The complete system, with E= 1 and 
K = 0 is as shown in Figure 32. 

The system was simulated by varying the gain E. It was observed that adding the 
torque feedback and changing the values of the gain E did not effect the transient re- 
sponse of the system. It was also observed that the variation of stiffness and the com- 
pliance was as predicted earlier in the theory section. To be able to observe the effect 
of backdriveablity, the system was simulated with K = 1 and efficiency equals to 0.95. 
These did not effect the transient response of the system either. 

As a result, by changing the value of k c system transient response can be adjusted 
and ideal value found to be 0.89. Adding the gain E, K , ?/ to the system did not effect 
the transient response. The steady state response of the system also agreed with that 
predicted. It is concluded therefore that the system transient response and stiffness are 
independent, as may be shown from the complete transfer function (0, = constant) for the 
system in Figure 32. 



~d 



(£) 

T7 



JlZ 

R 



i\Js + (c A -1 — k b .\ )s 4- k a 



R 



pot 



( 4 . 11 ) 
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Figure 32. Experimental Position Control S} stein With E= 1 & K=0. 
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V. EXPERIMENTAL STIFFNESS CONTROL 



A. NATURAL STIFFNESS OF THE SYSTEM 

As presented in the preceding chapters, every position control system has its own 
natural stillness. One can feel the stillness of the system when the output shaft is ro- 
tated. When we tried to rotate the output shaft of the educational system, it was ob- 
served that neither the output shaft nor the motor shaft rotated. Therefore, it was 
observed that the stillness of the educational system was infinite. But when we tried to 
rotate the motor shaft, we felt the stiffness of the shaft. The stiffness felt at the motor 
shaft was very small, Therefore, it was not possible to measure it by attaching a lever 
arm to the shaft directly. The stiffness was not even enough to lift the weight of the lever 
arm. On the other hand it was enough to stretch a thin regular rubber band. Therefore, 
the stiffness of a DC motor shaft may be found by using a low force rubber band as a 
spring. 

B. STIFFNESS TEST 

For this experiment, a regular rubber band, a protractor, a ruler and two different 
weight units were used. The rubber band was attached to a fixed support where different 
weights can be applied. Then 0.25 lb.(0. 1134 kg) unit applied to the band. Extended 
length of the band was measured and it was observed to be 4.8 in. (0.12192 m). When 
0.50 lb. (0.2268 kg)was applied, the amount of stretch was 6.8 in. (0.17272 m). The 
stiffness curve (weight vs amount of stretch) was plotted by using these two measure- 
ment. The best fitting curve's slope gave the stiffness of the rubber band. The stiffness 
curve of the band is shown in Figure 33. Since, the stiffness of the rubber band is 
known, the amount of force applied by using this band may be found from the stiffness 
curve of the band or by using the following formula. 
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F= KX 



(5.1) 



Where, K = The stiffness of the band (the slope of the stiffness curve) and 
X = Amount of stretch of the band. 

If the applied force is known, torque may be found by multiplying the force by the 
moment arm. 



r = FL 



(5.2) 



Where. L = Moment arm. 

The protractor with a small screw on it was mounted to the motor shaft. The rubber 
band attached to the screw and stretched ensuring there was 90 degrees of angle be- 
tween the rubber band and the moment arm as shown in Figure 34. Then, the amount 
of stretch in the rubber band length and the rotation of the shaft was measured. The 
following results were obtained: 

X = 5 in. (0.127 m), rubber band extension. 

L =1.75 in (0.0445 m). moment arm. 

0 m = 80 degrees (1.4 radian), measured rotation of the motor shaft. 

F = 1.226 X (from the curve using 5 in. extension), applied force. Then. 



r = 1.226.V x 0.0445m = 0.055A'm. 



So, the stiffness of the system was 



r _ 0.055 A'm _ . , , ^ A m 
0 m 1 .4 rad ' * rad. 



( 5 - 3 ) 



(5.4) 
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Figure 33. The Stiffness Curve of the Rubber Band. 

After the stiffness of the motor shaft was found, theoretical value of stiffness was 
calculated using the following equations. 

The stiffness of the system, keeping 0, constant, with N' = 1 and using equation 
(4.6), may be written as 
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figure 34. Application of the Rubber Band to the Motor Shaft. 



r t Y k a kpkp nl Kj- 

T 0 = ~ R 



Where, 0„ 




. Then the stiffness of the 



motor shaft will be 



t d k a kpkp 0l hj- 

^7 = _ R* 



(5.6) 



0 m = Angular displacement of the motor shaft. 
The measured values weic 
k, = 0.48 
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= 0.01 (Nm / volt) 



R 

K = ^ 



N = 30 



= 5.7 



volts 

rad 



So, the stillness will be 



~^r~ = - " ll * (M>1 x — = 0.037-^- (5.7) 

y m 30 ra<7 

When equation (5.7) and (5.4) were compared, it was observed that the percentage 
error was 5.4 %. So, it was concluded that the theoretical value of the natural stillness 
of the motor shaft matched with the one found by performing the rubber band test. 

After finding the stillness of the motor shaft, the variation of the stillness of the 
system with the feedback gain E. may be observed and compared with the theory. The 
stiffness variation experiment may be performed to observe the variation of the stiffness. 

C. STIFFNESS VARIATION EXPERIMENT 

The disturbance feedback system was designed by using an aluminum lever arm, two 
strain gages, an amplifier, a protractor, a voltmeter and weight units. 

Two strain gages were mounted on the site which is the closest point on the beam, 
to the output shaft, so as to be able to measure maximum strain. Also one strain gage 
was mounted top side and the other was mounted on the other side of the beam to be 
able to get maximum voltage as shown in Figure 35. 

The beam was mounted on the output shaft as shown in Figure 35. The voltage 
obtained from two strain gages was fed back to system through an amplifier. The 
voltmeter was connected to the system to be able to measure and observe the value of 
the gain E. The amplifier provided us the ability to vary the gain E. The protractor was 
mounted on the motor shaft as in the rubber band test. The value of the gain E was 
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Figure 35. The Stiffness Variation Test. 



changed by using the amplifier. After setting up the amplifier for certain values of the 
gain II, the beam was loaded with the weights as shown in figure 35. Again the multi- 
plication of the weight by the moment arm as presented in equation (5.3) gave the ap- 
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plied disturbance torque. The disturbance torque was calculated for two different 
weights. One set of data may be obtained by using the following method. 

The gain E was adjusted to be 2 (volts Nm). The beam was loaded first with 0.25 
lb.(0. 1 1 34 kg), then with 0.50 lb. (0.2268 kg) respectively. For each load the rotation of 
the motor shaft recorded. As can be noticed , the rotation was recorded for the motor 
shaft, not for the output shaft, because, it was easier to measure the rotation at this 
point. Then the applied disturbance torque was plotted against the rotation of the motor 
shaft for the two measurements as shown in Figure 36. The slope of the straight line 
gave us the stiffness of the system at the motor shaft. After obtaining necessary meas- 
urements, the stiffness of the motor shaft is converted to the stiffness of the system by 
using following formulas. 



Id _ Id 
0 m 



(5.8) 



The procedure may be summarized as follows. 



Table 1. EXPERIMENTAL DATA. 



Load Torque, r d 


Motor Shaft Rotation. 0 m 


Strain gauge voltage. 


0.228 Nm 


3.157 rad. 


0.456 volt. 


0.456 Nm 


6.6667 rad. 


0.912 volt. 



As can be seen above 



. - _ Q.456v<?// _ 1 volts 
0.228 Am - Nm 



(5.9) 
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UD 




Figure 36. The Stiffness Curve. 



and from the plot the slope was 6.6366 E-2 (Nm / rad). The stiffness of the motor shaft 
was 



= 6.6366 E - 2 x 30 = 2.05 
v 0 rad 



(5.10) 



1 he above procedure was repeated for several values of E, and the corresponding 
stiffness determined. The results are summarized in table 2. 
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Table 2. EXPERIMENTAL RESULTS. 



E(voIt/Nm) 


Stiffness (Nm/iad) 


0.045 


6.15 


0.12 


5.625 


1.37 


2.99 


2 


2.05 


3 


1.19 
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VI. ADAPTATION OF STIFFNESS CONTROL TO FINGER SYSTEM. 



We have proven experimentally that we can vary the stiffness of a position control 
system by means of the torque feedback. We now apply this concept to our original goal 
of attempting to vary the stiffness of a single finger joint of a robotic hand . The problem 
is exactly the same as the one previously described, except that the motor characteristics 
are different and the motor used in the joint is smaller. Therefore, we may control the 
finger joint by using the same methodology used in the preceding chapters. The motor 
used in this research and its characteristics are shown in Figure 37. Some of the pa- 
rameters may be obtain from the catalogue [Ref. 1). These are : 

A' r = 3.2 mNniA (0.453 oz-in A) 

R = 26 ohm 
J = 0.03 E-7 kgm* 

T m =7 msec. 

)] = 0.6 

X = 362 

10 volts may be considered as a typical voltage that can be applied to a motor in a 
finger joint. If the potentiometer has 270 degrees of scale, then 



/. _ 10 volts 

' pot 270 decrees 



= 0.037 



volts 

degrees 



= 2.11 



tv>/;s 

rad 



( 6 . 1 ) 



The value of k b may be found from the following equation: 



T 
1 » 



J_ 

kjkf, 



( 6 . 2 ) 
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M!6x!5 




scale 1:1 

dimensions in mm 





M915L61- . * . .0 




Figure 37. M915L61 Electric Motor. 



We can derive the following equation from equation (3.6), (3.7), (3.8). 



T RJ 
m k h K 



b^T 



(6.3a) 



Then, 



k b 



RJ 

T m k r 



(6-36) 



All values in equation (6.3b) can be obtained from the catalogue. So, 

k b = 3.48E — 3 vol,s f c , 

rad 

Since, spur gears were used in the system, the system will be backdriveable. There- 
fore, K = 1. 

After finding the necessary parameters, wc can simulate the system. The block dia- 
gram of the system is shown in Figure 38. The only difference of this system from the 
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educational servo system is k p . We don't need this gain in the linger joint system, because 
enough voltage can be supplied to the motor directly, but k 0 can be used in the linger 
system to obtain desired close loop time constant. To be able to obtain an ideal transient 
response without overshoot the forward path gain must be 0 < k c < 106. The natural 
stillness of the system, where k a = 1 will be 

JlL k 

h _ R 2^ 1.23/1-4x2.11 1 rad _ ( . „ A 'm (( .. 

0 o _n_ 0.0016572 6.385 Am rad { ' 

.V 

In equation (6.4) the value of the natural stiffness of the system is also given as the in- 
verse of the compliance, because again our simulation plot was the system compliance 
vs time. As can be seen from Figure 39, the system has no overshoot. Therefore, the 
system has ideal response and it is suitable for our goal. The system was also simulated 
for different values of the gain F and it was observed that the gain E doesn't effect the 
transient response of the system as expected. The stillness variation of the system is 
presented in Figure 40. 

To be able to adapt the position control system presented above to the finger sys- 
tem. the M915L61 electric motor was installed inside a brass case before the finger joint 
as shown in Figure 41 and an aluminum beam was used as a torque measurement sys- 
tem. 

One of the most important parameter which will decide the dimensions of the beam 
for the finger tip was the length and the width of the strain gages. The total length was 
therefore determined to 1.5 cm (0.59 in), and the width was 0.3 cm (0.1 18 in). Two strain 
gauges for each side, a total four strain gauges were mounted on the beam to get maxi- 
mum voltage. The width of the beam was decided to be 0.95 cm ( 0.375 in). The maxi- 
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Figure 38. The Finger Joint System Block Diagram. 
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compliance 




Figure 39. T he ringer Joint Simulation, k a — 3 , E = 0 (without torque feedback) 

mum force can be applied to the beam was considered to be 10 lbf or 44.48 N. '1 hercforc, 
using the following formula, the deflection of the beam may be obtained. 



STIFFNESS VS THE GAIN E 




Figure 40. Variation of the Stiffness in the Finger Joint System. 



Where, 

.i' m „ = Maximum deflection of the beam 
F = Applied force 

1 = Working distance of the beam, 2.54 cm. (I in) 



72 




Figure 41. The Huger Joint System. 

II = Modulus of elasticity, for aluminum, 71 Gpa. 

1 = Moment of inertia, 3.167 F-4 c//i 4 . 
b = Width of the beam, 0.95 cm (0.375 in) 
h = Thickness of the beam. 0.159 cm. (0.0625 in) 

A plot of deflection of the beam for different forces is presented in Figure 42. 

As can be seen from the Figure 41, the linger tip is only attached to the beam and 
not to the finger case, therefore it is free to move. When the disturbance torque is ap- 
plied to the finger via finger tip, the beam to which the tip is attached will be deflected. 
So, by feeding back the voltage obtained from the strain gauges to the system, the 
stiffness of the system may be changed as presented in preceding chapters. 



73 



FORCE VS DEFLECTION 




Figure 42. Deflection of (lie Beam. 
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VII. DISCUSSION 



A. MODELING OF THE SYSTEM: 

The main goal of' this research was to be able to control the amount of torque ap- 
plied to an object by a robotic finger which was actuated by a small electric motor 
through a gearbox. The torque applied on an object by the finger can be changed by 
varying the stiffness of the servomechanism installed into the finger. The stiffness vari- 
ation ability can be provided to the system by feeding back the disturbance torque 
measured from the object to the system through a variable gain E. 

Since we are mainly interested in controlling the torque, the efficiency and the 
backdriveabilty of the gearbox used in the system must be taken into account when 
modeling the system. As the efficiency increases the backdriveablitv will be higher, i.e 
the system will be more likely to be backdriveable. It is also important to notice that the 
efficiency of the gear train does not effect the actual transfer ratio of the gears in terms 
of displacement, velocity or acceleration, but greatly effects any torque related property. 

Different types of gearboxes can be used in a servomechanism. Gearboxes with high 
gear ratios can be used to increase the torque applied by the output shaft. Gearboxes 
with high gear ratios will help disturbance rejection. The effects discussed above must 
be added to the system block diagram to obtain an accurate model of the system in order 
to control the torque applied on the object. 

B. VARIABLE STIFFNESS CONTROL: 

After adding torque feedback to system, the stiffness of the system will be a func- 
tion of the gain E and the system will have its natural stiffness when the gain E is equal 
to zero. In the nonbackdriveable case, the natural stiffness of the system will be infinite, 
but this does not mean that the motor shaft stiffness will be infinite also. As the gain 1 
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increases, the stiffness of the system will decrease as shown in Figure 43. As the gain 
E increases, the stiffness decreases, the amount of rotation of the output shaft for the 
same amount of the disturbance torque measured, will be directly proportional to the 
gain E. Namely, to be able to obtain a higher rotation for the same amount of the dis- 
turbance torque, the gain E must be increased. 

The variation of the stiffness in a servomechanism was also proved experimentally 
on a larger model. As can be seen in Figure 43, the variation of the stiffness of the sys- 
tem measured experimentally has the same characteristics as predicted theoretically. For 
different values of E, the stiffness of the system measured experimentally was lower than 
the ones predicted theoretically. The main reason of this may be the nonlinearity that 
exist in DC motors. Since we are mainly interested in the stiffness variation, the exper- 
imental data proves that our prediction is correct, and that a variable stiffness servo 
system can be constructed. 

As presented before, the stiffness of the educational system was infinite, namely it 
was not possible to rotate the output shaft or the motor shaft by applying a disturbance 
torque to it due to the nonbackdriveablity of the gearbox. After adding the torque 
feedback, it was possible to achieve different stiffness by varying the value of the gain 
E. Therefore, it is still possible to vary the stiffness of the system even when it is 
nonbackdriveable. 

Another parameter which effects the magnitude of the natural stiffness in a servo 
system is k c ( forward path gain). As k 0 increases the natural stiffness of the system will 
increase. We didn't consider using k a for changing the stiffness of the system because for 
certain values of k a , the system may become unstable. Since, k a also effects the transient 
response of the system, after finding the values of k a which will give the desired transient 
response without overshoot, by keeping the magnitude of k a in defined limits, the time 
constant of the system can be changed to a certain value. It was also observed that 
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STIFFNESS(NONBACKDRIVABLE) 




figure 43. Comparison of Theoretical aiui Experimental Stiffness Variation 



adding the torque feedback to the system will not effect the transient response of the 



system. 
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C. APPLICATION TO ROBOTIC FINGER SYSTEM: 



Adaptation of the theory of variable stiffness to the finger joint was another im- 
portant part of the research. Since the finger joint is not a large end effector, the design 
of the torque measurement system must have certain size constraints. However, the 
problem was exactly the same as the one described in the large model analysis. There- 
fore. by using the same block diagram and obtaining certain parameters from the catalog 
and from related equations, the variable stiffness system can be adapted to a robotic 
finger joint. 

One of the main differences between the model used for experiments and the finger 
system was the dimensions of the beam. The beam, on which the strain gauges were 
mounted required careful design. Since a small beam was used in the design, to be able 
to get higher voltage, four small strain gauges were used. The size of the strain gauges 
was one of the main parameters which has an important effect on the design of the 
beam. 
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VIII. CONCLUSIONS 



1. The torque applied by an end effector to an object can be controlled by changing 
the stillness of the servomechanism. 

2. Certain parameters must be added to the system block diagram to obtain an ac- 
curate model of the system in order to control the torque applied on the object. 

3. After adding the torque feedback to the system, the stillness of the system will 
be a function of the feedback gain, while adding the torque feedback does not effect the 
system transient response. 

4. Even if the gearbox is nonbackdriveable, variable stiffness control of the 
servomechanism is possible. 

5. The variable stiffness concept may be easily applied to the design of a robotic 
finger tip. 
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APPENDIX A. ME3802 LABORATORY EXPERIMENT 2 DC SERVO 

SYSTEM-SPEED CONTROL 



A. OBJECTIVES 

The purpose of this experiment is to: 

1. Become familiar with the components of an electro-mechanical speed control 
system 

2. Use basic measurement equipment to perform experiments 

3. Measure the transfer functions of the components of the speed control system 

4. Perform a close loop speed control test of the system 

B. EQUIPMENT: 

For this experiment. you will need the following equipment 

1. Feedback educational servo system type ES151 

2. Dual trace oscilloscope 

3. Digital voltmeter 

4. Chart recorder 

5. A stop watch 

6. Miscellaneous leads, wires and connectors 

Examine and familiarize yourself with the equipment, and determine how to operate 
and connect the various pieces together. 

C. METHOD 

1. Compare the close loop feedback control system shown in Figure 44 and 
Figure 45 with the schematic shown on the front panel of the servo system, 
Figure 46. Figure 44 shows the complete schematic, while Figure 45 shows only those 
parts that will be used in the experiment 2. Be sure to identify the correspondence be- 
tween all elements in both systems. Note the availability of certain system signals at the 
bottom of the front panel. 

2. The first part of the experiment deals with the identification of the various pa- 
rameters shown in F'igure 45. Connect the system as shown in Figure 47, making sure 
the INTERNAL COMPENSATION switch is IN. Switch on, set input potentiometer 
0, to zero and use the SERVO AMPLIFIER and OPERATIONAL AMPLIFIER SET 



80 




figure 44. Position Control System Block Diagram 



ZIZRO controls to achieve no motor rotation with minimum motor current shown on the 
panel meter. Unsure that the FUUDBACK SFLUC IOR switch is fully anti-clockwise. 

3. Tachometer Constant k r 

In this test, the output voltage from the tachometer is rccoulcd for various speeds. 
T he slope ol the line of voltage plotted against speed then gives the tachometer constant 
in volts/RPM. Connect the system as shown in figure 47, and set PI to 1 and P2 to 1. 
With the digital volt meter connected as shown, turn the input potentiometer to obtain 
constant speed of rotation of the motor. Using a stop watch, record the time for a given 
number of revelations (say 25). Note that the tachometer is mounted on the motor 
shaft, before the 30:1 gearbox driving the output potentiometer, l ake this in to account 
when calculating the speed of the tachometer shaft. Change the setting of input 
potentiometer and repeat the test to obtain a total of live readings. Plot voltage against 
speed, draw the best straight line you can and calculate the slope. T he expected result 
should be about 0.00245 volts/RPM. 
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Figure 45. Open Loop Speed Control Block Diagram 



4. Potentiometer Constant k po , 

Connect the apparatus as shown in Figure 48, noting that the system is open loop. 
In this test we will determine the potentiometer constant i.e. the relationship between the 
angular rotation of the potentiometer and the resulting voltage generated. Note that 
both input and output potentiometers are identical. Set the input potentiometer to point 
to zero degrees and record the error voltage. Rotate the input potentiometer from zero 
to 120 degrees in 20 degree steps. For each step record the voltage and subtract the 
voltage corresponding to zero degree position. Plot voltage against angular position and 
from the slope of the best straight line that fits the data determine k por The expected re- 
sult should be in the region of 5.7 volt/radian. 

5. Motor & Servo Gain K s 

T his parameter is defined as the ratio of the output speed of the motor divided by 
the input voltage to the servo amplifier. Connect the system as shown in Figure 49, with 
P2 set to 0.7, and use the input potentiometer to establish a constant speed of the motor 
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shaft. Use the digital voltmeter to measure the input voltage to the servo amplifier and 
record this value. Determine the motor speed by connecting the digital voltmeter to the 
VELOCITY socket, record the voltage and use the previously calculated value of 
tachometer constant k, to calculate the speed of the motor. Adjust the input 
potentiometer to give a different speed and repeat the test for five data points. Plot 
motor speed against input voltage and from the best straight line through the data points 
determine K s . The expected value is about 270 radians / sec per volt. 

O.Motor Time Constant T m 

In this test, the system is connected as an open loop speed control system, as shown 
in, Figure 50 subject to a step input. The step input is obtained from a function gener- 
ator which should be set to provide a square wave output with a frequency of about 0.1 
Hz, corresponding to a step input ever}’ 5 seconds. Set P2 to 0.2. To avoid using exces- 
sive record paper, use the oscilloscope to observe the output speed and to qualitatively 
verify the response. The output should look similar to that shown in Figure 51. T he 
purpose of the experiment is to determine the time constant of the exponential increase 
in motor speed in response to the step change in demanded speed. Once a trace similar 
to that shown in Figure 51 is observed, obtain a copy on the chart recorder by switch- 
ing it on, adjusting the sensitivity, and recording a few input responses. Make a note of 
the time base for the chart recorder. The time constant is calculated by determining the 
time taken for the system to achieve 63% of the demanded output, as shown in 
Figure 52. Measure the time constant from at least 3 response curve and calculate the 
average value. The expected time constant is T m = O.lSseconds. 

7. Connect the system as a close loop feedback control system as shown in 
Figure 53. Set FI to I. All parameters shown in Tigure 44 on page 81 are now known 
except for the gain k 0 . For the servo system this gain is actually the product of the op- 
erational amplifier gain and the value of the potentiometer F2. Note that P2. being a 
potentiometer, is actually an attenuator and hence its gain components must be less than 
unity. When socket B is connected to socket F. the gain of the operational amplifier is 
I, while connecting B to F reduces the gain to 0.1. Set P2 to 1 and perform a close loop 
step response as described in the previous section for the open loop. Observe the results 
on the oscilloscope, and make a sample chart recording output to determine the time 
constant the closed loop system. By analyzing the close loop transfer function together 
with the experimental values obtained, calculate a theoretical time constant for the close 
loop step response, and compare it with the measured values. 
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Figure 46. Equipment Configuration 
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Figure 47. Equipment Configuration 
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Figure 48. Equipment Configuration 
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Figure 49. Equipment Configuration 
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Figure 50. Equipment Configuration 
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I'ig lire 51. Output Speed 
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liguie 53. t'quipincnt Configuration 
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